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(57) Abstract: The invention relates to asystem for estimating the 
position, speed and orientation of a vehicle (10) comprising means 
for determining components of two non-collinear constant pointing 
vectors (formula I), according to the vehicle body axes, means for 
determining components of said non-collinear constant pointing vec- 
tors (formula II) according to the Earth's axes (A), means for deter- 
mining three components of the angular speed (formula III) of the 
vehicle in the axes of the body thereof, means for correcting said 
angular speed (formula IH) with the u^ correction and obtaining a 
corrected angular speed (formula IV), a control module (14) using 
a control principle in order to calculate said u^ correction according 
to a formula [formula V], wherein c is a positive gradient. When 
said corrected speed (formula IV) is used as the input of an integra- 
tion module of cinematic equations, said equations are stable with 
respect to ISS and the estimation error of the directive cosines ma- 
trix (formula VI) and Euler (formula VTI) angles remains bounded. 

(57) Resumen: Sistema para estimar position, velocidad y orienta- 
ci6n de un vehfculo (10), que comprende medios para determinar las 
componentes, segun ejes cuerpo del vehfculo, de dos vec tores unita- 
rios constantes no colineales (formula I); medios para determinar las 
componentes, segun ejes tierra, de dichos vec tores unitarios constan- 
tes no colineales (formula H); medios para determinar las tres compo- 
nentes de velocidad angular (formula HI) del vehfculo en ejes cuerpo; 
medios para corregir dicha velocidad angular (formula HI) con una 
correccion y obtener una velocidad angular corregida (formula 
IV); un modulo de control (14), que implementa una ley de con- 
trol para calcular dicha correccidn donde dicha ley de control es: 
(formula V) siendo a 
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on escalar positivo, de forma que a] utilizar dicha velocidad angular corregida (formula IV) como entrada a un m6dulo de integracidn 
de las ecuaciones cinematicas, 6stas son estables en sentido ISS y el error en la estimaci6n de la matriz de cosenos direc tores (formula 
VI) y de los angulos de Euler (formula VIT) se mantiene acotado. 



